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87 


„ ( af— cd\ 

A = d 


88 


1 _ Kae - bd) - e(af- cd) 
d(ae — bd) 


89 


^ _ aef— bdf- aef+ cde 
d{ae — bd) 


90 


\ - ~ bdf+ cde 
d(ae — bd) 


91 


x - bf+ ce 
ae — bd 


92 


r ei 
C " ES 


93 


D = — 
ES 


94 


e d 
a = -G+-FH 


95 




96 


-e d 
6 ES ES 


97 


d e 
ES ES 


98 


„ eG + dFH 

E = 

a 


99 


-dG + eFH 
E= b 



FIG. 31 
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EQ 
NUMBER 


EQUATION 


100 


E ^ -eH + dFG 
g 


101 


pp dH + eFG 
ES= h 


102 


eG + dFH -dG + eFH 
a b 


103 


FH ad + be 
G ae — bd 


104 


-eH+dFG dH+eFG 
g h 


105 


FG _ dg + eh 
H dh — eg 


106 


FH FG (ad + be)(dg + eh) 2 
G X H ~ (np - hd\(dh - pq\ ~ 


107 


p _ + \(ad + be)(dg + eh) 
~ ~4(ae-bd)(dh-eg) 


108 


E = ±Jl - F 2 


109 


(J) = arctan(£', F) 


110 


1 . c FH _ H _ f + l(ae - bd)(dh - eg)) (ad+ be) 
F G G V 4(ad+be)(dg + eh)> " (ae-bd) 

_ + l(ad + be)(dh - eg) 
- A/ (ae - bd)(dg + eh) 


111 


H H 1 



FIG. 32 
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EQ 
NUMBER 


EQUATION 


112 


1 

+ 1 1 + i 

J(D 2 


113 


G = ±Jl-H 2 


114 


vj/ = arctan(G, H) 


115 




116 


S ±Jd 2 + e 2 
i E 


117 


r - e v E 

E 1 ,2 2 
±*Jd + e 


118 


c = A— 

±*Jd + e 


119 


^ d E 

D = x 

E -L. L 2 2 

±*Jd +e 


120 


±<Jd + e 



FIG. 33 
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EQ 
NUMBER 


EQUATION 


121 


i(l -Ag-Bh) = IJ+ 1 




sign(/) = -sign(l -Ag-Bh) 


123 


y = arctan(Z), C) 


124 


DE 


125 


c ei 
b ~ CE 


126 


sign(FH) = *g*( ae _ b $ 


127 


J = 


gi 1 
-CH+ sign(FH)DFG\ 


128 


J = 


hi 

DH+sign(FH)CFG 


129 


I (i-Agi-Bhi-l) 

J 



FIG. 34 
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o 


O 


O 


~3 

u_ 

-H 


O 


CFJ 


O 


±HJ 


DHJ 


±FGJ 


±HJ 


DHJ+ 
CFGJ 




o 


o 


O 


O 


±FJ 


DFJ 


±(-HJ) 


0 


-CHJ 


±(-HJ) 


±FGJ 


-CHJ+ 
DFGJ 




±BS 


±AS 


BS 


Bei 


Adi 


Adi+Bei 


±BS 


±AS 


Adi+Bei 


Bei 


Adi 


Adi+Bei 


"55 


±S 


o 


SO 


±ES 


0 


CES 


±S 


0 


CS 


±ES 


0 


CES 


-B 


o 


±s 


DS 


0 


±ES 


DES 


0 


CO 

+1 


DS 


0 


±ES 


DES 


"o 


±AS 


±(-BS) 


Aai+Bbi 


±AS 


±(-BS) 


Aai+Bbi 


Aai 


Bbi 


Aai+Bbi 


Aai+Bbi 


Aai+Bbi 


Aai+Bbi 


5 


o 


±(-S) 


-DS 


0 


CO 

1 

+1 


-DS 


0 


±(-GS) 


-DGS 


±FHS 


±(-GS) 


-DGS+ 
CFHS 




±S 


o 


CS 


±S 


0 


SO 


±GS 


0 


CGS 


±GS 


±FHS 


CGS+ 
DFHS 




CO 


co 


o_ 


CD 


0 


0 


X 
CD 


X 
CD 


H'O 


X 
CD" 


X 
CD" 


H'O 


LU 
LU 


o 


co 

t — 


o 


u_ 

LU 


LL 
LU 


u_ 

LU 


0 


0 


0 


u_ 

UJ 


LL. 
LU 


E,F 


Q 

cj 


±1,0 


0,±1 


Q 

o" 


±1,0 


+i 

0" 


Q 

CJ 


±1,0 


0,±1 


0 
0 


±1,0 


+i 
0" 


0 

0" 


case 


03 


-O 


o 

T — 


CO 
CM 


-O 

CNJ 


O 
CN 


CO 
CO 


_q 
co 


0 

CO 


CO 


J3 


0 
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description 


case 


condition 


handling 


zero pitch & 
zero roll 


1 


g = h = 0 


E<- 1 
F<-0 
G<- 1 
//<- 0 


zero roll 


2a 


b = d = g = 0 


FJ _ h 
S ~ a 


2b 


a = e = h = 0 


FJ -g 
S b 


2c 


a -h 
b~ g 


handle via 2a or 2b 


2 




G<- 1 
//<-0 

F<-sign(^)Vl-£ 2 



73/73 



description 


case 


condition 


handling 


zero pitch 


3a 


b = d = h = 0 


e 

HJ _ -g 
S e 


3b 


a = e = g = 0 


HJ _ h 
S " d 


3c 


a - s 
b h 


handle via 3a or 3b 


3 




E<r- 1 

F<-0 

H= sign(^)7l-G 2 


non-zero pitch 
& non-zero roll 


4 


(g*0)A(fc*0) 


handle via general solution 



FIG. 37 



